void PrintData(){
//  Serial.print("Motor Axis Command: ");
//  Serial.println(motor.axisCommand[RX_ROLL]);
//  Serial.print("Motor Command: ");
//  Serial.println(motor.command[MOTOR_RIGHT]);
//  Serial.println(RXCHval[RX_THROTTLE]);
//  
//Serial.println(RXCHval[RX_THROTTLE]);

//Serial.println(map(RXCHval[RX_YAW],1500,2000,0,180));
//Serial.println(motor.axisCommand[RX_YAW]);

//Serial.println(RXCHval[RX_ROLL]);
//Serial.println(RXCHval[RX_PITCH]);
//Serial.println(RXCHval[RX_YAW]);

#if OUTPUT_STUFF ==1

  


#endif



#if OUTPUT_MOTOR == 1   
  Serial.print("Left Motor: ");
  Serial.print(motor.command[MOTOR_LEFT]);
  Serial.print(" Right Motor: ");
  Serial.print(motor.command[MOTOR_RIGHT]);
  Serial.print(" Front Motor: ");
  Serial.print(motor.command[MOTOR_FRONT]);
  Serial.print(" Rear Motor: ");
  Serial.println(motor.command[MOTOR_REAR]);
#endif

#if OUTPUT_MOTOR == 1
/*
  Serial.println("***************************************");
  Serial.println(BMOTOR);
  Serial.println(FMOTOR);
  Serial.println(LMOTOR);
  Serial.println(RMOTOR);
  Serial.println("***************************************");
*/
#endif

#if OUPUT_ACCELD == 1
    Serial.print("ACCEL PITCH: "); 
    Serial.println(acceld.value[SENSOR_PITCH]);
    Serial.print("ACCEL ROLL: "); 
    Serial.println(acceld.value[SENSOR_ROLL]);
    Serial.print("ACCEL YAW: "); 
    Serial.println(acceld.value[SENSOR_YAW]);
    
  Serial.println("******************************");

    Serial.print("GYRO PITCH: "); 
    Serial.println(gyrod.value[SENSOR_PITCH]);
    Serial.print("GYRO ROLL: "); 
    Serial.println(gyrod.value[SENSOR_ROLL]);
    Serial.print("GYRO YAW: "); 
    Serial.println(gyrod.value[SENSOR_YAW]);

  Serial.println("******************************");
#endif

#if OUTPUT_MINMAX ==1

 for(int i =0; i<3;i++){
    Serial.print("Accel Min "); 
    Serial.print(i);
    Serial.print(": ");
    Serial.println(acceld.min[i]);
    Serial.print("Accel Max "); 
    Serial.print(i);
    Serial.print(": ");
    Serial.println(acceld.max[i]);
  }
 for(int i =0; i<3;i++){
    Serial.print("Gyro Min "); 
    Serial.print(i);
    Serial.print(": ");
    Serial.println(gyrod.min[i]);
    Serial.print("Gyro Max "); 
    Serial.print(i);
    Serial.print(": ");
    Serial.println(gyrod.max[i]);
  }
#endif

}

